/*
 *  Copyright 2004 by Texas Instruments Incorporated.
 *  All rights reserved. Property of Texas Instruments Incorporated.
 *  Restricted rights to use, duplicate or disclose this code are
 *  granted through contract.
 *
 */

#include <std.h>
#include <tsk.h>
#include <sem.h>
#include <gio.h>

#include <csl_dat.h>
#include <csl_cache.h>


#include <fvid.h>
#include <edc.h>
#include <vport.h>
#include <vportcap.h>
#include <vportdis.h>
#include <saa7105.h>

#include <csl_vphal.h>
#include <evmdm642.h>
#include <evmdm642_capParamsSDTVDefault.h>
#include <evmdm642_disParamsSDTVDefault.h>

#include "colorbar.h"


/* caputure configuration parameters */
/* embedded sync mode is recommended as it offers better re-sync capability */

/* Available video modes are: NTSC720 & PAL720 */
static VPORTCAP_Params EVMDM642_vCapParamsChan
  = EVMDM642_CAP_PARAMS_CHAN_EMBEDDED_DEFAULT(NTSC720/*PAL720*/);

static TVP51XX_ConfParams EVMDM642_vCapParamsTVP5146
  = EVMDM642_CAP_PARAMS_TVP51XX_EMBEDDED_DEFAULT(
      NTSC601/*PAL601*/, COMPOSITE/*SVIDEO*/, 0);

#ifdef _PIP
static TVP51XX_ConfParams EVMDM642_vCapParamsTVP5150
  = EVMDM642_CAP_PARAMS_TVP51XX_EMBEDDED_DEFAULT(
      NTSC601/*PAL601*/, COMPOSITE, 1/*0*/);
#endif
VPORT_PortParams EVMDM642_vCapParamsPort
  = EVMDM642_CAP_PARAMS_PORT_EMBEDDED_DEFAULT;


/* display configuration parameters */
VPORT_PortParams EVMDM642_vDisParamsPort
  = EVMDM642_DIS_PARAMS_PORT_DEFAULT;

static VPORTDIS_Params EVMDM642_vDisParamsChan
  = EVMDM642_DIS_PARAMS_CHAN_BT656_DEFAULT(NTSC/*PAL*/);

static SAA7105_ConfParams EVMDM642_vDisParamsSAA7105
  = EVMDM642_DIS_PARAMS_SAA7105_SDTV_DEFAULT(
      NTSC720/*PAL720*/, SVIDEO/*COMPOSITE*/);



/* heap IDs defined in the BIOS configuration file */
extern Int EXTERNALHEAP;


/*
 * ======== main ========
 */
main()
{
    /******************************************************/
    /* open CSL DAT module for fast copy                  */
    /******************************************************/
    CSL_init();
    CACHE_clean(CACHE_L2ALL, 0, 0);
    CACHE_setL2Mode(CACHE_256KCACHE);
    CACHE_enableCaching(CACHE_EMIFA_CE00);
    CACHE_enableCaching(CACHE_EMIFA_CE01);
    DAT_open(DAT_CHAANY, DAT_PRI_LOW, DAT_OPEN_2D);

}


/* ======== tskVideoLoopback ========
 * video loopback function.
 */
void tskVideoLoopback()
{
    Int status;
    FVID_Handle disChan;
    Int frames = 0;
    FVID_Frame *disFrameBuf;
    Int numLinesDis = EVMDM642_vDisParamsChan.imgVSizeFld1;
    Int numLinesCap = EVMDM642_vCapParamsChan.fldYStop1 -
       EVMDM642_vCapParamsChan.fldYStrt1+1;


    Int numLines = (numLinesDis > numLinesCap) ? numLinesCap : numLinesDis;

    Int i;
    FVID_Handle capChan;
    Int numPixels = EVMDM642_vCapParamsChan.fldXStop1 -
       EVMDM642_vCapParamsChan.fldXStrt1+1;
    FVID_Frame *capFrameBuf;
    Int capLinePitch = EVMDM642_vCapParamsChan.fldXStop1 -
       EVMDM642_vCapParamsChan.fldXStrt1+1;
    Int disLinePitch = EVMDM642_vDisParamsChan.imgHSizeFld1;
    Int aMuxMode1 = 1;


#ifdef _PIP
    VPORTCAP_Params EVMDM642_vCapParamsChan2 = EVMDM642_vCapParamsChan;
    FVID_Handle capChan2;
    FVID_Frame *capFrameBuf2;
    Int yPitch = capLinePitch >> 1;
    Int cPitch = ((capLinePitch >> 2) + 7) & (~ 7);
    Int aMuxMode2 = 1;

#endif


    numLines *= 2; /* both fields */
    /******************************************************/
    /* allocate both capture and display frame buffers    */
    /* in external heap memory                            */
    /******************************************************/
    EVMDM642_vCapParamsChan.autoSyncEnable = 1;
    EVMDM642_vCapParamsChan.segId = EXTERNALHEAP;
    EVMDM642_vDisParamsChan.segId = EXTERNALHEAP;
    EVMDM642_vCapParamsTVP5146.hI2C = EVMDM642_I2C_hI2C;
#ifdef _PIP
    EVMDM642_vCapParamsTVP5150.hI2C = EVMDM642_I2C_hI2C;
#endif
    EVMDM642_vDisParamsSAA7105.hI2C = EVMDM642_I2C_hI2C;


    /******************************************************/
    /* initialization of capture driver                   */
    /******************************************************/
    capChan = FVID_create("/VP0CAPTURE/A/0",
            IOM_INPUT, &status, (Ptr)&EVMDM642_vCapParamsChan, NULL);

#ifdef _PIP
    EVMDM642_vCapParamsChan2.scale = VPORT_SCALING_ENABLE;
    EVMDM642_vCapParamsChan2.fldOp = VPORT_FLDOP_FLD1;
    EVMDM642_vCapParamsChan2.thrld >>=1;
    capChan2 = FVID_create("/VP1CAPTURE/A/1",
            IOM_INPUT, &status, (Ptr)&EVMDM642_vCapParamsChan2, NULL);
#endif

    /******************************************************/
    /* initialization of display driver                   */
    /******************************************************/
    disChan = FVID_create("/VP2DISPLAY", IOM_OUTPUT,
        &status, (Ptr)&EVMDM642_vDisParamsChan, NULL);


    /******************************************************/
    /* configure video encoder & decoder                  */
    /******************************************************/
    FVID_control(disChan, VPORT_CMD_EDC_BASE + EDC_CONFIG,
        (Ptr)&EVMDM642_vDisParamsSAA7105);
    FVID_control(capChan, VPORT_CMD_EDC_BASE + EDC_CONFIG,
        (Ptr)&EVMDM642_vCapParamsTVP5146);
#ifdef _PIP
    FVID_control(capChan2, VPORT_CMD_EDC_BASE+EDC_CONFIG,
        (Ptr)&EVMDM642_vCapParamsTVP5150);
#endif


    /******************************************************/
    /* start capture & display operation                  */
    /******************************************************/
    FVID_control(disChan, VPORT_CMD_START, NULL);

    FVID_control(capChan, VPORT_CMD_START, NULL);
#ifdef _PIP
    FVID_control(capChan2, VPORT_CMD_START, NULL);
#endif

    /********************************************************/
    /* request a frame buffer from display & capture driver */
    /********************************************************/
    FVID_alloc(disChan, &disFrameBuf);
    FVID_alloc(capChan, &capFrameBuf);
#ifdef _PIP
    FVID_alloc(capChan2, &capFrameBuf2);
#endif
    frames ++;


    while(1){/* loop forever */

        /* copy data from capture buffer to display buffer */
        /***************************************************/
        if(frames % 300 == 0){
            aMuxMode1 ^= 1; /* toggle between 1 & 0, composite and s-video */
            FVID_control(capChan, VPORT_CMD_EDC_BASE + TVP51XX_SET_AMUXMODE, (Ptr)aMuxMode1);
            TSK_sleep(250);
        }

        for(i = 0; i < numLines; i ++) {
            DAT_copy(capFrameBuf->frame.iFrm.y1 + i * capLinePitch,
                     disFrameBuf->frame.iFrm.y1 + i * disLinePitch,
                     numPixels);
            DAT_copy(capFrameBuf->frame.iFrm.cb1 + i * (capLinePitch >> 1),
                     disFrameBuf->frame.iFrm.cb1 + i * (disLinePitch >> 1),
                     numPixels>>1);

            DAT_copy(capFrameBuf->frame.iFrm.cr1 + i * (capLinePitch >> 1),
                     disFrameBuf->frame.iFrm.cr1 + i * (disLinePitch >> 1),
                     numPixels>>1);
        }

#ifdef _PIP
        if(frames % 250 == 0){
            FVID_control(capChan2, VPORT_CMD_EDC_BASE + TVP51XX_SET_AMUXMODE, (Ptr)aMuxMode2);
            aMuxMode2 ^= 1; /* toggle between 0 & 1, J18 and J17 */
            TSK_sleep(250);
        }

        for(i = 0; i < (numLines>>1); i ++) {
            DAT_copy(capFrameBuf2->frame.iFrm.y1 + i * yPitch,
                     disFrameBuf->frame.iFrm.y1 + i * disLinePitch
                     + (disLinePitch >> 1),
                     (numPixels>>1));
            DAT_copy(capFrameBuf2->frame.iFrm.cb1 + i * cPitch,
                     disFrameBuf->frame.iFrm.cb1 + i * (disLinePitch >> 1)
                     + (disLinePitch >>2 ),
                     (numPixels >> 2));

            DAT_copy(capFrameBuf2->frame.iFrm.cr1 + i * cPitch,
                     disFrameBuf->frame.iFrm.cr1 + i * (disLinePitch >> 1)
                     +(disLinePitch >> 2),
                     (numPixels >> 2));
        }
#endif
        DAT_wait(DAT_XFRID_WAITALL);
        FVID_exchange(capChan, &capFrameBuf);

#ifdef _PIP
        FVID_exchange(capChan2, &capFrameBuf2);
#endif
        FVID_exchange(disChan, &disFrameBuf);
        frames ++;
   }
}
